clc;clear;close all;
%t0=0,t1=1,q0=0,q1=1;
%planeTrajectoryFirstOrder(t0,t1,q0,q1);
%t0=0,t1=1,q0=0,q1=1,v0=1,v1=2;
%planeTrajectorySecondOrder(t0,t1,q0,q1,v0,v1);
%t0=0,t1=1,q0=0,q1=1,v0=0,v1=1;
%planeTrajectoryThirdOrder(t0,t1,q0,q1,v0,v1);
%%
figure,
x1=1,     z1=0;     x2=0.8,   z2=0.4;  
planeTrajectoryFirstOrder(x1,x2,z1,z2,100);hold on;
x3=0.2,   z3=0.8;  
planeTrajectoryFirstOrder(x2,x3,z2,z3,100);hold on;
x4=-0.2,  z4=0.4;  
planeTrajectoryFirstOrder(x3,x4,z3,z4,100);hold on;
x5=-0.8,  z5=0.2;  
planeTrajectoryFirstOrder(x4,x5,z4,z5,100);hold on;

figure,
x1=1,     z1=0;    v0=0;    v1=1;    x2=0.8,   z2=0.4;  
v1=planeTrajectorySecondOrder(x1,x2,z1,z2,v0,v1,100);hold on;
x3=0.2,   z3=0.8;  v0=v1;  v1=2;
v1=planeTrajectorySecondOrder(x2,x3,z2,z3,v0,v1,100);hold on;
x4=-0.2,  z4=0.4;  v0=v1;  v1=2;
v1=planeTrajectorySecondOrder(x3,x4,z3,z4,v0,v1,100);hold on;
x5=-0.8,  z5=0.2;  v0=v1;  v1=2;
v1=planeTrajectorySecondOrder(x4,x5,z4,z5,v0,v1,100);hold on;

figure,
x1=1,     z1=0;    v0=0;    v1=1;    x2=0.8,   z2=0.4;  
v1=planeTrajectoryThirdOrder(x1,x2,z1,z2,v0,v1,100);hold on;
x3=0.2,   z3=0.8;  v0=v1;  v1=2;
v1=planeTrajectoryThirdOrder(x2,x3,z2,z3,v0,v1,100);hold on;
x4=-0.2,  z4=0.4;  v0=v1;  v1=2;
v1=planeTrajectoryThirdOrder(x3,x4,z3,z4,v0,v1,100);hold on;
x5=-0.8,  z5=0.2;  v0=v1;  v1=2;
v1=planeTrajectoryThirdOrder(x4,x5,z4,z5,v0,v1,100);hold on;
